NPS  ARCHIVE 
1997.09 


GERRARD,  D. 

NAVAL  POSTGRADUATE  SCHOOL 
Monterey,  California 


THESIS 


DYNAMIC  CONTROL  OF  A  VEHICLE 

WITH 

TWO  INDEPENDENT  WHEELS 

by 

Douglas  R  Gerrard 

September,  1997 

Thesis  Advisor:                                                          Xiaoping  Yun 
Second  Reader:                                                          Roberto  Cristi 

Thesis 
G3323 

Approved  for  public  release;  distribution  is  unlimited. 

1 

REPORT  DOCUMENTATION  PAGE 


Form  Approved 
OMB  No.  0704-0188 


Public  reporting  burden  for  this  collection  of  information  is  estimated  to  average  1  hour  per  response,  including  the  time  for  reviewing 
instruction,  searching  existing  data  sources,  gathering  and  maintaining  the  data  needed,  and  completing  and  reviewing  the  collection  of 
information.  Send  comments  regarding  this  burden  estimate  or  any  other  aspect  of  this  collection  of  information,  including  suggestions  for 
reducing  this  burden,  to  Washington  headquarters  Services,  Directorate  for  Information  Operations  and  Reports,  1215  Jefferson  Davis 
Highway,  Suite  1204,  Arlington,  VA  22202-4302,  and  to  the  Office  of  Management  and  Budget,  Paperwork  Reduction  Project  (0704-0188) 
Washington  DC  20503. 


1.  AGENCY  USE  ONLY  (Leave  blank) 


2.    REPORT  DATE 

September  1997 


3.  REPORT  TYPE  AND  DATES  COVERED 

Master's  Thesis 


4.  TITLE  AND  SUBTITLE 

DYNAMIC  CONTROL  OF  A  VEHICLE  WITH  TWO  INDEPENDENT 

WHEELS 


6.    AUTHOR(S) 

Gerrard,  Douglas  R. 


5.  FUNDING  NUMBERS 


7.  PERFORMING  ORGANIZATION  NAME(S)  AND  ADDRESS(ES) 

Naval  Postgraduate  School 
Monterey,  CA  93943-5000 


8.  PERFORMING  ORGANIZATION 
REPORT  NUMBER 


9.  SPONSORING  /  MONITORING  AGENCY  NAME(S)  AND  ADDRESS(ES) 


10.  SPONSORING  /  MONITORING 
AGENCY  REPORT  NUMBER 


11.  SUPPLEMENTARY  NOTES 

The  views  expressed  in  this  thesis  are  those  of  the  author  and  do  not  reflect  the  official  policy  or  position  of  the  Department 
of  Defense  or  the  U.S.  Government. 


12a.  DISTRIBUTION  /  AVAILABILITY  STATEMENT 

Approved  for  public  release;  distribution  is  unlimited. 


12b.  DISTRIBUTION  CODE 


13.  ABSTRACT  (maximum  200  words) 

The  feedback  control  and  modeling  of  a  mobile  robot  with  two  wheels  that  are  independently 
steerable  and  drivable  is  studied.  Two-wheel  steer  vehicles  increase  their  maneuverability  when  both 
wheels  are  powered  and  therefore  increases  their  performance  in  confined  spaces.  A  dynamic  feedback 
control  algorithm  is  developed,  which  enables  the  vehicle  to  move  from  any  initial  configuration 
(position  and  orientation)  to  any  final  configuration.  Simulation  results  are  presented  to  verify  the 
independent  control  of  the  two  position  variables  and  the  orientation  variable.  A  comparison  with  a 
two-wheel  steering  and  one  wheel  drive  vehicle  shows  that  driving  both  wheels  increases  performance 
and  maneuverability. 


14.  SUBJECT  TERMS 

Two  Wheel  Steer,  Two  Wheel  Drivable  Vehicle,  Dynamic  Feedback  Control  Algorithm,  Highly 
Maneuverable  Vehicle 


15.  NUMBER  OF 
PAGES 

38 


16.   PRICE  CODE 


17.  SECURITY 
CLASSIFICATION  OF 
REPORT 

Unclassified 


18.  SECURITY  CLASSIFICATION  OF 
THIS  PAGE 

Unclassified 


19.  SECURITY  CLASSIFI-  CATION 
OF  ABSTRACT 

Unclassified 


20.   LIMITATION  OF 
ABSTRACT 

UL 


NSN  7540-01-280-5500 


Standard  Form  298  (Rev.  2-89) 
Prescribed  by  ANSI  Std.  239-18 


Approved  for  public  release;  distribution  is  unlimited 


DYNAMIC  CONTROL  OF  A  VEHICLE  WITH  TWO  INDEPENDENT  WHEELS 

Douglas  R.  Gerrard 

Lieutenant,  United  States  Navy 
B.S.,  University  of  Missouri,  1990 

Submitted  in  partial  fulfillment  of  the 
requirements  for  the  degree  of 


MASTER  OF  SCIENCE  IN  ELECTRICAL  ENGINEERING 


from  the 


NAVAL  POSTGRADUATE  SCHOOL 

September  1997 


n?5  A£cHwe. 


ABSTRACT 


The  feedback  control  and  modeling  of  a  mobile  robot  with  two  wheels  that  are 
independently  steerable  and  drivable  is  studied.  Two-wheel  steer  vehicles  increase  their 
maneuverability  when  both  wheels  are  drivable  and  therefore  increases  their  performance 
in  confined  spaces.  A  dynamic  feedback  control  algorithm  is  developed,  which  enables 
the  vehicle  to  move  from  any  initial  configuration  (position  and  orientation)  to  any  final 
configuration.  Simulation  results  are  presented  to  verify  the  independent  control  of  the 
two  position  variables  and  the  orientation  variable.  A  comparison  with  a  two-wheel 
steering  and  one  wheel  drive  vehicle  shows  that  driving  both  wheels  increases 
performance  and  maneuverability. 
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I.  INTRODUCTION 

Wheeled  mobile  robots  come  in  a  number  of  different  kinematic  structures. 
Typical  robots  have  a  steerable  front  wheel(s),  and  the  rear  wheel(s)  whose  orientation 
relative  to  the  vehicle  body  is  fixed,  such  as  an  automobile  or  a  bicycle.  Some  robots  are 
the  differential-drive  type  which  have  two  co-axial  wheels  that  are  independently  actuated 
to  achieve  forward/backward  and  rotational  motions.    The  synchronous-drive  type  of 
mobile  robots  such  as  Nomad  200  [Ref.  1]  have  all  the  wheels  steer  and  rotate  together  so 
that  the  wheels  are  parallel  all  the  time.  Mobile  robots  such  as  these  have  two  degrees  of 
freedom  and  are  nonholonomically  constrained. 

This  thesis  describes  a  type  of  mobile  robot  that  has  two  independently  steerable 
and  drivable  wheels.  Using  the  bicycle  as  an  example,  this  type  of  mobile  robot  would 
have  both  the  front  and  rear  wheels  drivable  as  well  as  steerable.  It  has  been  shown  that  a 
mobile  vehicle  with  two  steerable  wheels  with  one  drivable  can  be  controlled  using 
dynamic  feedback  control  [Ref.  2].  One  example  of  this  type  of  mobile  robot  is  the  SR2 
mobile  robot  from  Cybermotion  Inc.  which  has  three  steerable  and  drivable  wheels  [Ref. 
3].  Four-wheel  steering  automobiles  [Ref.  4  and  Ref.  5]  and  fire  trucks  [Ref.  6]  are  other 
examples,  both  of  which  are  designed  for  improving  maneuverability.  Although  these 
types  of  vehicles  are  still  nonholonomically  constrained,  they  can  still  be  controlled  to 
follow  a  path  with  independent  orientation  [Ref.  7]  and  are  extremely  maneuverable  in 
confined  space  [Ref.  8]. 

This  thesis  focuses  on  modeling  and  control  of  a  vehicle  with  two  wheels,  both  of 
which  are  steerable  and  drivable.  The  vehicle  has  four  input  variables,  the  steering 
velocities  of  the  two  wheels  and  the  rotational  velocity  of  both  wheels.  The  problem  of 
how  to  steer  and  deliver  the  torque  to  the  two  wheels  in  order  to  independently  control  the 
position  and  orientation  of  the  vehicle  body  is  studied.  In  particular,  a  dynamic  feedback 
algorithm  is  developed,  which  linearizes  and  decouples  the  system.  The  output  in  this 
case  is  the  two-dimensional  position  and  one-dimensional  orientation  of  the  vehicle  body. 


Consequently,  the  algorithm  enables  the  vehicle  to  follow  any  desired  position  trajectory 
and  orientation  trajectory.  Furthermore,  it  will  be  shown  that  the  input-output 
linearization  cannot  be  achieved  by  any  static  state  feedback  [Ref.  2].  Dynamic  feedback 
linearization  was  previously  applied  to  three-wheel  mobile  robots  (with  a  free  or  steering 
wheel)  that  have  only  two  inputs  [Ref.  9]. 

One  of  the  benefits  of  having  both  wheels  drivable  would  include  increasing  the 
maneuverability  the  vehicle.  Both  wheels  drivable  would  allow  pure  rotation  in  place  and 
pure  translation  in  the  lateral  direction  of  the  vehicle.  Imagine  parallel  parking  by  just 
rotating  all  wheels  perpendicular  to  the  body  of  the  vehicle  and  laterally  translating  into 
the  parking  space.  Another  benefit  would  be  the  ability  to  have  the  torque  distributed  to 
the  wheels  depending  on  the  road  conditions,  and  if  a  wheel  began  to  slip,  the  torque 
delivered  to  the  wheels  could  be  transferred  to  the  other  wheel.  This  would  result  in  a 
two  wheel  steerable,  one  wheel  drivable  vehicle  until  the  slipping  wheel  regains  traction. 


II.  KINEMATIC  MODEL  OF  THE  VEHICLE 

A.         NOTATIONS 

Figure  1  shows  a  diagram  of  a  vehicle  with  two  independent  steering  wheels.  The 
two  wheels  are  located  at  pi  and  p2  on  the  vehicle,  respectively,  po  is  located  at  the  center 
of  gravity  of  the  vehicle  which  is  assumed  to  be  located  on  the  pi  -  p2  axis.  The  distance 
from  po  to  pi  is  a  and  the  distance  from  po  to  pi  is  b. 

Four  coordinate  frames  are  defined  for  describing  position  and  orientation  of  the 
vehicle  [Ref.  2].  {U}  is  the  earth-fixed  coordinate  frame.  { 1 }  is  the  frame  fixed  on 
wheel  1.  xi  is  chosen  to  be  along  the  horizontal  radial  direction  and  yi  is  in  the  lateral 
direction.  Likewise,  {2}  is  the  frame  defined  for  wheel  2.  {0}  is  the  frame  defined  at 
point  po-  yo  is  chosen  to  be  a  unit  vector  pointing  from  p2  to  pi,  and  xo  is  orthogonal  to 
the  line  segment  from  p2  to  pi. 

The  orientation  of  the  vehicle  body  is  characterized  by  (J)0,  which  is  the  angle  from 
xu  to  xq.  (f>i  and  (fb  are  two  steering  angles  defined  from  Xo  to  X;,  i  =  1,2.  With  these 


Figure  1:  Coordinate  systems  for  a  two  steering  wheel  vehicle 


notations,  we  are  ready  to  establish  homogeneous  transformations  describing  one  frame 
relative  to  another.  In  what  follows,  at,T  denotes  the  homogeneous  transformation  of 
frame  {b}  relative  to  frame  {a}.    Because  the  motion  of  the  vehicle  is  restricted  to  the 
two-dimensional  plane,  homogeneous  transformations  are  3  x  3  rather  than  4x4. 
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B. 


VELOCITY  KINEMATICS 


With  the  help  of  homogeneous  transformations  given  above,  the  velocities  of 
point  pi  and  point  p2  can  be  computed.  The  homogeneous  position  vector  of  point  pi  and 
P2  expressed  in  frame  {0}  are: 
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These  points  are  represented  in  frame  { U }  by 
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The  velocity  of  the  points  pi  and  p2  (or  differentiated  with  respect  to  frame  {U } ) 
expressed  in  frame  {U}  are: 
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In  order  to  derive  the  nonholonomic  constraint  equations  of  wheel  1 ,  the  velocity 
of  point  pi  relative  to  frame  {U}  is  expressed  in  frame  { 1 }: 


pl=(vlTy'uPi=(uoTn,vp,= 
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where  the  terms  indicated  by  *  are  irrelevant  in  the  computation.  Likewise,  the  velocity 
of  point  2  relative  to  frame  {U}  is  expressed  in  frame  {2}  as  follows: 


2P2  = 


i0  cos(0o  +  02 )  +  y0  sin(<>0  +  (|)2 )  +  bty0  cos((|)2 ) 
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C.         CONSTRAINT  EQUATIONS 

The  vehicle  is  subjected  to  four  nonholonomic  constraints.  The  first  two 
constraints  are  derived  from  the  fact  that  the  wheels  cannot  move  in  the  lateral  direction. 
That  is,  the  y  component  of   px  and    p2  is  zero: 

-  x0  sin(0o  +  0, )  +  y0  cos(0o  +  0, )  +  a0o  sin(0, )  =  0 

-  x0  sin((j)0  +  02 )  +  >>0  cos((l)o  +  02 )  ~  ^00  sin(02 )  =  0 

The  other  two  constraints  are  due  to  the  no-slip  condition.  Let  r  be  the  radius  of 
the  wheels,  and  0j,  i=l,2  be  the  angular  displacement  of  the  wheels  (driving  angles)  then 


the  x  component  of  l  px  and  2  p2  is  equal  to  the  velocity  of  the  wheel  in  that  direction. 

These  two  constraints  are  expressed  as: 

i0  cos((|>0  +  (t>! )  +  y0  sin((J)0  +  ()>!)-  a§0  cos^ )  =  r6, 
Xq  cos((J)0  +  <j)2 )  +  y0  sin((|)0  +  (|>2 )  +  &<j)0  cos((()2 )  =  r02 

Choosing  the  following  generalized  coordinate  vector 

4  =  [xo     yo     ei     02     <t>o     <h     §2] 
the  four  constraints  can  be  written  as 

A(q)q  =  0 

where  the  4  x  7  dimensional  matrix  A(q)  is  given  by 


A(q)  = 
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D.         KINEMATIC  MODEL 

The  4x7  dimensional  matrix  A(q)  has  a  3-dimensional  null  space.  Let 

S(q)  =  [sl(q)     s2(q)     s3(qj\ 

be  a  7  x  3  full-rank  matrix  whose  columns  Sj(q),  i=  1,2,3,  are  in  the  null  space  of  A(q),  that 
is,  A(q)  Sj(q)  =  0.  The  three  columns  of  S(q)  form  a  basis  for  the  null  space  of  A(q). 
Since  the  generalized  velocity  q  is  always  in  the  null  space  of  A(q)  as  characterized  by 
Equation  ( 1 ),  it  may  be  expressed  as 

q  =  S{q)l\  (2) 

where  r|  is  a  3-dimensional  vector  of  independent  velocities.  It  is  noted  that  the  choice  of 
S(q)  and  the  corresponding  r\  is  not  unique.  For  a  certain  choice,  r|  may  not  necessarily 
represent  any  physical  velocity. 

As  stated  earlier,  both  wheels  are  steerable  and  powered.  However,  only  three 
velocity  inputs  are  needed.  If  we  choose  r|  to  be  the  three  angular  input  velocities,  that  is, 
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the  corresponding  S(q)  is  then  given  by 
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E. 


DYNAMICS 


Since  only  one  wheel  rotation  velocity  is  used  as  one  of  the  inputs,  the  torque 
delivered  to  both  wheels  must  be  incorporated  into  this  single  input.  This  relationship  is 
obtained  by  solving  the  dynamic  equation  for  the  forces.  Figure  2  shows  the  dynamic 
forces  acting  on  the  body  and  wheel  unit.  Summing  the  moments  about  the  zo  axis  at  the 
center  of  gravity  yields 

X  M^  =  -aFx  cos(t>,  +bF2  cos(|>2  =  /B(|>0  (4) 

where  Ib  is  the  body  moment  of  inertia.  For  the  wheel,  summing  the  moments  at  the 
point  where  wheel  i,  (i  =  1,2)  makes  contact  with  the  surface  yields 


Sm 


cFi+ti  =lw<dl+rmwal 


where  Iw  is  the  wheel  moment  of  inertia  and  mw  is  the  mass  of  the  wheel.    Since  the 
acceleration  a  =  rQi , 

-t1+e,(Av+>'2"v) 


F     = 


(5) 


Combining  Equation  (4)  and  Equation  (5)  provide  the  governing  equation  of  motion. 

ax,  cos(j),  -bi2  cos(|)2  -aIwQx  cose)),  +bIwQ2  cos(t)2  =c^b^o  (6) 


where  Iw  =  Iw  +  rAm 
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From  Figure  3,  the  following  relationships  can  be  derived.  The  velocity  diagram 
and  the  law  of  sine's  provide  the  following  relationship  between  6,  and  02 . 
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Figure  2:  Dynamic  force  diagram 
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Figure  3:  Kinematic  velocity  diagram 

Differentiating  Equation  (7)  and  Equation  (8)  and  making  substitutions  and 
solving  for  02  provide 

0,  sin^j  sin(4>2  -(|)1)  +  (j)0[4)2(a  +Z?)sin(|)1  cos())2  -§{{a  +b)cos^>l  sin cf>2 J 

rsin(|)2  sin((})2  -^j) 

Likewise,  solving  for  (j)0 

—  0,rsin2((j)2  —  (j)j)  +  ^)0(<3  +  Z?)|sin(t)2  cos((()2  -<|)j)(^2  -<j>i)  +  <i>2  cos§2  sin(^<|>2  -(J),)! 

$0  = 


(9) 


{a  +  b) sin (|>2  sin((J)2  -§x) 

Combining  Equation  (6),  Equation  (9),  and  Equation  (10)  gives  the  equation  for 
the  angular  acceleration  of  wheel  1  as  a  function  of  both  wheels  input  torque  and  the 
angular  velocity  of  the  body. 


(10) 
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(11) 


Equation  (11)  can  be  integrated  to  provide  the  angular  velocity  of  wheel  1  for  the 
input  to  the  control  algorithm.  In  this  way,  both  torque  inputs  are  combined  into  a  single 
input  necessary  for  use  as  one  of  the  three  inputs  for  the  control  algorithm.  The  other  two 
inputs  will  be  the  two  steering  angular  velocities. 

The  next  chapter  develops  the  control  for  the  vehicle  and  uses  these  three 
velocities  as  the  inputs  for  the  feedback  control  algorithm.  From  these  three  inputs  to  the 
control  algorithm,  the  seven  dimensional  state  vector  provides  the  outputs  of  the  vehicle's 
position  and  orientation. 


10 


III.  FEEDBACK  CONTROL 

Considering  the  generalized  coordinate  vector  q  as  the  state  vector,  the  kinematic 
model  of  the  vehicle  represented  in  the  state  space  form  is  characterized  by  Equation  (2) 
in  which  r\  is  the  input  to  the  system.  To  control  the  position  and  orientation  of  the 
vehicle,  the  natural  choice  for  the  output  equation  is: 


y  =  h(q)  = 


Jo 


Once  the  state  equation  and  output  equation  are  derived,  the  next  step  is  to  design 
a  controller  for  this  system.  Feedback  linearization  technique  is  used  [Ref.  10].  It  has 
been  shown  that  a  static  feedback  is  not  capable  of  linearizing  the  system  [Ref.  2]  which 
will  be  repeated  here.  Furthermore,  the  dynamic  feedback  that  linearizes  and  decouples 
the  system  will  also  be  derived. 


A.         STATIC  FEEDBACK 

To  derive  a  static  nonlinear  feedback,  we  differentiate  the  output  equation. 

dh(q)  .      dh(q) 


■q  = 


■S(q)r\  =  0(q)l\ 


dq  dq 

where  Q>{q)  denotes  the  decoupling  matrix  of  the  system.  If  Q>{q)  is  of  full  rank,  we  may 

apply  a  static  feedback  of  the  form 

T\  =  ®-l(q)\L 

to  obtain  the  linearized  closed-loop  system: 

y  =  \l 

In  the  present  case,  the  decoupling  matrix  is  given  by 


dh(q) 


dq 


Sllte) 

0 

o" 

•*2i(<7) 

0 

0 

s5i(<?) 

0 

0 
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which  is  unfortunately  singular.  Therefore,  it  is  not  possible  to  have  a  static  feedback  that 
linearizes  the  system. 


B. 


DYNAMIC  FEEDBACK 


If  a  system  is  not  linearizable  by  any  static  feedback,  it  may  nevertheless  be 
linearizable  by  a  dynamic  feedback.  The  construction  of  a  dynamic  feedback  consists  of 
two  steps.  First  we  construct  a  static  feedback  shown  below,  which  is  called  Feedback  I: 


r|  = 


*!,(*)    0    0 
0  1    0 

0         0    1 


M 


The  application  of  this  feedback  results  in  the  following  closed-loop  system: 


yi 

>3. 


S2\IS\\ 
S5\IS\\ 


vF21((|)0,{t)1,())2) 


M-i 


It  is  noted  that  the  first  component  of  the  output  is  linearized  and  decoupled  from 
the  other  two  components.  Next,  we  apply  another  feedback  in  order  to  linearize  the 
latter  two  components  of  the  output.  To  do  so,  we  differentiate  them  once  more. 


r^ni 

h 

*n 

d$0 

.h. 

.^21. 

Hi+Hi 

d¥2l 

4>o  "•-  M-i 

.  <%  . 

ay 


ii 


d§2 

^21 

9(1),        d§2 
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♦  l 


Noting  that  <j>0  =s5iT|i  =s51/su  \i{,  and 


v 

_<i>2_ 

= 

.^3. 

= 

>2_ 

>3_ 

we  may  represent  the  above  equation  as  follows: 

a(«)|ii+0z(«¥i+Q(9) 


?2 
3^3 


^2 
^3 


where 


12 


=  Ql(q)iil+Q2(q)\i2{+n(g) 


V-2 

y-3 


where 


Qx(q)  = 


^i 
T 
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Qiiq)  = 


d${ 


dV 
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Q(q)  =  y.i 
Now  applying  Feedback  II  given  by 


d<|>0 


s5l/s 


n 


n 


5(1), 

ay 
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^2 
>*3 


=  Q-1(^) 

the  latter  two  outputs  are  linearized  as 


M_V3 


a<j>2 

5^       5<j)  2 


-a(^i-e2(^i 


^2 
A 

Furthermore,  let  ji ,  =  V! ,  therefore 

y\  =  vi 

The  complete  controller  with  three  feedback  loops  for  the  steering  angles  and  the 
wheel  velocity  input  is  depicted  in  a  block  diagram  in  Figure  4.  Figure  5  shows  the 
MATLAB  Simulink  program  diagram. 

The  simulation  results  are  provided  in  the  next  chapter.  The  results  showed  a 
significant  improvement  in  performance  over  the  two-wheel  steerable,  one-wheel 
drivable  vehicle. 
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Figure  4:  Dynamic  feedback  controller 
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IV.  SIMULATION 


A.         TEST  CONDITIONS 

The  vehicle  feedback  control  system  shown  in  Figure  4  has  been  simulated  using 
Matlab  Simulink  (Figure  5).  Each  block  in  the  figure  is  implemented  by  the  use  of  an  S- 
function  [Ref.  1 1].  To  stabilize  each  of  the  linearized  subsystems,  the  linear  feedback  is 
further  designed.  In  the  simulation,  the  linear  feedback  gain  is  chosen  to  place  the  poles 
of  each  subsystem  at  -5  and  -15.  The  system  was  tested  and  compared  to  the  performance 
of  the  dynamic  control  algorithm  for  the  two  steering,  one  wheel  drivable  vehicle.  The 
following  are  the  initial  and  goal  configurations  used  for  the  test: 


*0 

'  0  " 

?0 

= 

0 

_v 

init 

50° 

Xq 

10 

y0 

= 

-5 

_V 

eoal 

-10° 

The  parameters  used  for  the  simulation  are  designed  to  be  realistic  of  an  actual 
robot  and  in  MKS  units  and  are  as  follows: 

a  =  0.55  b  =  0.30  c  =  0.25 

r  =  0.10  /B=2.0  7W=0.05 

Figure  6  clearly  shows  that  the  path  from  the  initial  point  to  the  goal  is  a  straight 
line.  This  direct  path  was  the  result  for  the  two  steering  wheel  vehicle  regardless  if  one  or 
both  wheels  were  powered. 
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Figure  6:  X-Y  plot 
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B.         INDEPENDENT  CONTROL  OF  POSITION  AND  ORIENTATION 

Figure  7  through  Figure  14  show  the  response  of  the  two  wheel  drivable  vehicle 
compared  to  the  one  wheel  drivable  vehicle  for  the  same  initial  and  final  conditions  used 
in  the  test.  It  is  evident  from  Figure  7  to  Figure  14  that  in  either  case,  both  the  position 
and  orientation  converge  to  the  goal.  This  confirms  that  the  position  and  orientation  can 
be  independently  controlled.  However  the  manner  in  which  they  reach  the  goal  differ 
significantly. 

The  vehicle  with  only  one  of  the  wheels  drivable  quickly  accelerates  and  rotates 
early  in  the  trajectory  and  then  slowly  approaches  the  goal.  The  vehicle  with  both  wheels 
drivable  has  a  steady  velocity  and  rotation  throughout  the  trajectory.  This  is  especially 
evident  in  Figure  1 1  and  Figure  12.  The  body  angle  versus  time  clearly  show  the 
differences  between  the  two  simulations,  even  though  both  trajectories  follow  a  direct 
path  to  the  goal. 

Both  the  constant  rate  of  speed  and  constant  rate  of  rotation  of  the  body  would  be 
highly  beneficial  if  there  were  on  board  sensors  scanning  the  environment  during  the 
journey. 
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Figure  7:  Two  wheel  drivable  vehicle  (X:  dashed,  X  dot:  solid) 
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Figure  8:  One  wheel  drivable  vehicle,  Xu  versus  time 


18 


0 

-0.5 

-1 

-1.5 


—      -2 
o 

■D 

>■ 
T3   — 


2.5  - 


-3  - 
-3.5 

-4 
-4.5 

-5 


^^ —                I 

1                                     T 1 

"*"■""*>"•  "~~"«~~Ws«^^, 

"v. 

\ 

V 

\ 
\ 

-v 
\ 
x 
^ 

X 

% 

N 

\ 

- 

\ 

X 
X 

1                            1 

I 

6  8 

time  (sec) 


10 


12 


Figure  9:  Two  wheel  drivable  vehicle  (Y:  dashed,  Y  dot:  solid) 
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Figure  10:  One  wheel  drivable  vehicle,  Yu  versus  time 
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Figure  11:  Two  wheel  drivable  vehicle  (phi:  dashed,  phi  dot:  solid) 
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Figure  12:  One  wheel  drivable  vehicle  (phi:  dashed,  phi  dot:  solid) 
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Figure  13:  Two  wheel  drivable  vehicle  (phi  1:  dashed,  phi  2:  solid) 
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Figure  14:  One  wheel  drivable  vehicle  (phi  1:  dashed,  phi  2:  solid) 
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C.         ONE  WHEEL  VERSUS  TWO  WHEEL  DRIVABLE  VEHICLES 

Figure  1 5  and  Figure  1 6  emphasize  the  differences  between  the  one  wheel 
drivable  and  two  wheel  drivable  simulations.  Even  though  both  cases  have  two  wheel 
steering,  when  both  wheels  are  drivable,  the  transition  from  the  initial  starting  point  to  the 
final  goal  point  is  much  more  linear  than  when  only  one  wheel  is  powered.  The  body 
angle  was  adjusted  by  90  degrees  to  the  longitudinal  axis  of  the  vehicle,  so  that  its 
orientation  is  from  a  more  familiar  perspective. 

In  Figures  15  and  16,  each  frame  of  the  vehicle  represents  the  vehicle's  position, 
wheel  angle,  and  the  vehicles  orientation  at  a  particular  point  in  time.  Each  snapshot  is 
taken  at  equal  intervals  of  time.  These  two  figures  clearly  show  that  when  only  one  wheel 
is  being  drivable  it  must  approach  the  final  goal  point  slowly  to  align  to  the  correct 
orientation.  When  both  wheels  are  drivable,  the  rotation  of  the  vehicle  is  consistent 
throughout  the  trajectory. 
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Figure  15:  Two  wheel  drivable  vehicle  trajectory 
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Figure  16:  One  wheel  drivable  vehicle  trajectory 
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V.  CONCLUSION  AND  FUTURE  WORK 

This  thesis  studied  the  control  of  a  two-wheel  vehicle  with  both  wheels  steerable 
and  drivable.  Unlike  one-wheel  steer  mobile  robots  (e.g.,  the  automobile/bicycle/tricycle 
type  of  mobile  robots),  the  control  of  two-wheel  steer  robots  are  less  intuitive  and  more 
difficult.  By  making  both  wheels  drivable  the  complexity  of  the  control  algorithm 
increases  further.  Using  a  dynamic  nonlinear  feedback,  independent  control  of  the 
position  and  orientation  of  a  mobile  robot  was  obtained.  The  orientation  is  no  longer  an 
uncontrollable  state  variable  governed  by  internal  dynamics.  Consequently,  while  the 
vehicle  follows  a  direct  path  to  its  goal,  its  orientation  does  not  have  to  be  in  the 
tangential  direction  of  the  path.  For  example,  the  orientation  of  the  vehicle  body  can  be 
independently  controlled  for  scanning  with  onboard  sensors. 

Further  work  on  this  project  includes: 

The  concept  developed  in  this  thesis  can  be  extended  to  an  all-wheel  steering,  all 
wheel  drivable  vehicle  with  four  independent  wheels.  This  may  require  redefining  the 
constraint  equations  as  well  as  the  kinematic  force  and  velocity  equations  may  be 
required. 

Distribution  of  the  torque  between  the  wheels  would  be  greatly  beneficial  if  one 
of  the  wheels  began  to  slip.  This  simulation  used  a  constant  torque  value  for  each  wheel 
initially,  but  later  trials  found  that  a  constant  torque  divided  by  the  angular  speed  of  the 
wheel  squared  provided  the  best  overall  performance.  More  research  is  needed  on  how 
exactly  to  distribute  the  torque  to  each  wheel  depending  on  the  steering  angle,  final  and 
initial  position  and  configuration,  and  surface  conditions. 

It  was  stated  from  Equation  (3)  that  the  input  velocities,  rj,  were  chosen 
arbitrarily.  Perhaps  better  performance  could  be  obtained  from  using  the  two  angular 
wheel  velocities  and  one  steering  angular  velocity  for  the  input  parameters.  These  new 
inputs  would  make  each  input  torque  independent  of  the  other,  allowing  one  of  the 
wheels  to  slip. 
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